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1.  INTRODUCTION 

The  need  for  more  sophisticated  digital  flight  controllers  has 
become  more  apparent  in  recent  years.  With  the  advent  and  perfection  of 
microcomputer  systems,  digital  flight  control  systems  have  become  extremely 
feasible  for  controlling  and  maneuvering  the  complex  motions  of  a  modern 
aircraft. 

The  works  of  Daly  [1]  and  Jackson  [2]  have  shown  the  merits  of  mini¬ 
computer  based  flight  control  systems.  But  from  a  practical  viewpoint,  micro¬ 
computer  systems  are  more  attractive  for  reasons  of  compactness.  Particularly 
in  recent  years,  with  rapid  advances  in  the  LSI  technology,  more  and  more  of 
the  sophisticated  features  of  a  minicomputer  are  being  incorporated  into  a 
microcomputer,  without  increasing  its  size.  Reliability  considerations  also 
dictate  the  use  of  a  multiple  number  of  dedicated  controllers,  rather  than  a 
single  large  controller  performing  all  the  control  operations.  The  present  day 
microcomputer  systems  are  ideally  suited  for  dedicated  controller  applications 
as  in  an  aircraft. 

Optimal  control  techniques  have  been  extensively  applied  for  the 
design  of  flight  control  systems,  due  to  the  need  for  control  and  trajectory 
optimization.  The  dynamical  equations  of  an  aircraft  being  highly  nonlinear, 
the  direct  application  of  these  techniques  Is  computationally  involved.  No 
closed  form  solution  is  available  for  such  problems,  and  one  has  to  resort  to 
numerical  methods,  which  might  prove  too  slow  for  high  speed  real-time 
applications  like  in  an  aircraft.  Hence,  for  practical  reasons,  the  plant 
equations  are  linearized  around  equilibrium  points  corresponding  to  different 
flight  conditions,  and  the  standard  results  of  linear  regulator  theory  are 
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applied  for  designing  FID  controllers.  This  has  been  attempted  before  by 
Daly  [1]  and  Jackson  [2]. 

A  major  restriction,  from  a  practical  viewpoint,  of  the  optimal 
linear  regulator  theory  is  that  the  solution  is  obtained  in  a  state  feedback 
form.  In  most  practical  cases,  such  a  control  is  difficult  to  implement  due  to 
the  inaccessibility  of  all  the  state  variables  for  feedback.  In  such  cases,  the 
optimal  state  regulator  is  implemented  by  generating  the  inaccessible  states 
using  a  state  observer.  Adding  a  state  observer  increases  the  order  of  the 
system,  and  may  result  either  in  an  increased  cost  if  implemented  in  hardware, 
or  an  increased  controller  execution  time  if  implemented  in  software.  This 
may  be  unavoidable  if  the  plant  is  not  stabilizable  without  feedback  from  such 
inaccessible  states.  But  in  many  cases,  the  plant  can  be  stabilized  and  a 
satisfactory  performance  achieved,  by  suitably  designing  a  linear  output 
regulator. 

Until  recently,  no  systematic  procedure  had  been  formulated  for 
designing  an  optimal  output  regulator.  The  works  of  Medanic,  [3]  and  [4],  now 
provide  an  efficient  computational  method  for  the  design  of  static  and  dynamic 
output  regulators . 

It  has  been  widely  acknowledged  that  dynamic  models  of  many  physical 
systems  possess  a  two-time-scale  property,  i.e.,  have  'slow'  and  'fast'  states. 
Singular  perturbation  theory  [5],  [6],  [7],  [8]  exploits  this  property  of 
systems  to  provide  us  with  computationally  efficient  tools  for  designing 
controllers  based  on  reduced-order  models . 

It  has  been  noticed  that  linearized  models  of  many  aircrafts  possess 
a  two-time-scale  property — pitch  angle,  velocity  and  altitude  being  the  'slow' 
variables,  and  angle  of  attack  and  pitch  rate  being  the  'fast'  variables. 
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Moreover,  Che  'fast'  state  variables  are  stable.  It  is  also  known  that  the 
'fast'  variables  are  more  difficult  to  measure  than  the  'slow'  variables  which 
are  directly  available  to  the  pilot  on  his  control  panel.  Hence,  the  simplest 
controller  design  would  involve  only  a  knowledge  of  the  three  'slow'  states. 
Therefore,  from  the  very  nature  of  the  problem,  it  is  evident  that  both 
singular  perturbation  theory  and  output  regulator  theory  can  be  directl  oplied 

to  solve  the  aircraft  control  problem.  The  design  based  on  singular  pf  rba- 

tion  theory  would  involve  neglecting  the  'fast'  dynamics,  and  obtaining 
reduced  order  model  based  only  on  the  'slow'  variables.  A  state  regulator 
would  then  be  designed  based  on  this  reduced  order  model.  The  design  based  on 
output  regulator  theory  would  consider  the  'slow'  variables  as  the  plant 
outputs.  These  outputs  would  then  be  used  to  design  an  optimal  static  output 
feedback.  These  two  design  methodologies  can  be  easily  extended  to  design 
dynamic  PI  controllers  as  well. 

In  this  thesis,  flight  control  systems  have  been  designed  based  on 
singular  perturbation  theory  and  output  regulator  theory.  The  relative  merits 
and  demerits  of  these  two  design  techniques  has  been  examined  based  on  their 
real  time  implementation  on  a  Z-80  based  microcomputer  system. 
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2.  AIRCRAFT  MODELING 

In  order  to  proceed  with  any  meaningful  control  system  design,  a 
mathematical  description  of  the  plant  dynamics  is  first  required.  This  is 
generally  obtained  in  the  form  of  a  set  of  first-order  ordinary  differential 
equations.  In  this  thesis,  a  simplified  model  of  an  airplane's  longitudinal 
equations  of  motion  is  used. 


2.1.  Dynamical  Equations 

The  dynamical  equations  for  the  aircraft  model  are  derived  based  on 
a  rigid  body  assumption  (ignoring  aeroelasticity  etc.).  In  general  an  airplane 
coordinate  system  can  be  assumed  to  have  the  configuration  as  shown  in  Figure  2.1 
where  the  symbols  refer  to  the  quantities  as  given  in  Table  2.1  [9].  For  the 
types  of  aircrafts  as  the  one  studied  here,  the  angle  of  attack  (a)  is  usually 
small,  and  therefore  small  angle  approximations  can  be  made.  This  leads  to  the 
following 

sin  a  28  a 
cos  a  98  1 

u  *  v  cos  a  **  v 

u  ■  v  cos  a-va  sin  a  28  v -  vaa  28  v 

*  v  sin  a  8  vq 

(I)  *  v  sin  a  +  vd  cos  a  =  va  +  vd  28  vd 

sin  9  *  sin(v  +  a)  *  sin  v  cos  a  +  sin  a  cos  v 
98  s  in  v  +  a  cos  v 


*  sin  v 
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Table  2.1.  Definition  of  symbols  used 

ct:  angle  of  attach 
9 :  pitch  angle 
v:  flight  path  angle 
M:  mass  of  the  aircraft 
V:  velocity 
H:  altitude 

W:  weight  of  the  aircraft 
moment  of  inertia 
XCG:  center  of  gravity 
S:  wing  surface  area 
p:  air  density 
C:  chord  length 

X:  body  axis  «jk 

Z:  verticle  normal  to  body  axis 
L:  lift  force 
D:  drag  force 


T:  thrust 


cos  9  ■  cos(v  +  a)  »  cos  v  cos  a -sin  v  sin  a 


*  cos  v  -  a  sin  v 


Summing  the  forces  in  the  x-direction 


-Mu  -  Wsin9  4-  Lsina  -  (D-T)cos  a  ■  0. 


Now,  using  these  approximations 


-Mv-  Wsin  v  -  D  +  T  *  0 


V  *  £  [T-D-  Wsin  v] . 

M 


Summing  the  forces  in  the  Z-direction 


-M(w-u0)  +  W  cos  0  -  L  cos  a  -  (D-T)  sin  a  *  0 . 


Again,  using  the  above  approximations 


-MV  ( d- 9)  +  W  cos  v  -  L  *  0 


a  =*  0  -  r^7  [L-W  cos  v] . 
MV 


Summing  the  moment  in  the  Y-direction 


I  Q  ■  M  • 

Ln  y 

Also,  for  the  rate  of  change  of  altitude  we  have 


H  ■  V  sin  v. 


The  lift,  drag,  and  moment  can  be  written  as 


L  -  |  PV2SC( 

D  -  Y  oV2SCd 

M  "4  pV2ScC 
y  2  m 


(2.1) 


(2.2) 


(2.3) 


(2.4) 


(2.5) 


*  i*-% 
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where  Che  coefficients  C„,  C  ,  and  C ,  depend  on  wing  plan  form  used  and  place¬ 
s'-  m  a 

menc  of  the  wing  (and  sometimes  placement  of  the  engines).  All  the  coefficients 
in  these  equations  can  be  found  for  any  size  airplane  using  the  specified 
configuration  and  by  looking  up  the  wing  specifications.  These  equations  are 
generally  simplified  for  mach  numbers  less  than  1.0  by 


C«  ■  Cto  +  cu“  +  Ctf6f 


Cd  '  Cio  +  Ct  +  Cdf6f 


(2.6) 


where 


C  =■  C  +  C  „C.  +  C  6  +  C  ,6,  -  (d  +  e) 

m  mo  mc&  l  me  e  mf  f  2V 


6^:  flap  deflection 


5  :  aileron  deflection 
e 

throttle  position. 


Any  airplane  can  now  be  simulated,  perhaps  with  minor  modifications  due  to  engine 
placement,  tail  configuration  or  Mach  number.  For  simplicity,  the  coefficients 
of  the  GAT  II  simulation  as  described  in  Daly’s  thesis  [1]  are  used  with  minor 


revisions , 

Thrust  is  a  more  complicated  subject.  It  is  highly  dependent  on  Mach 
number,  altitude  and  the  type  of  engine  used  (turboprop,  turbofan,  propeller, 
etc.).  In  general  there  are  no  easily  found  formulae  for  thrust.  For 
simplicity,  the  thrust  formulation  (propeller)  used  in  Daley's  thesis  was 
adopted,  which  is 

Map  ■  C  +  C  H  +  C  N  +  C  N<5 
Po  pn  pn  pnt  t 


Bhp  -  Cbo  +  CbnN  +  CbpMap  +  ShH 
T  -  Ne  Bhp(Cto  +  CtvV+CthH+CtvhVH) 


(2.7) 


where 


Map:  manifold  pressure 
N:  RPM 

Bhp:  brake  horsepower 
Ne:  number  of  engines. 


The  values  of  the  various  coefficients  defined  above  are  listed  in  Table  2.2. 
The  equilibrium  flight  conditions  used  are 


V  - 

0 

190-66  ft/sec. 

H  - 

2000  ft 

0 

0  - 

0  “a  *  0. 

o 

O  O 

VX5 

and  controls  u^ 

x,  ■  a 

u,  *  5 

1 

1  e 

x2  -  V 

u2  =  6f 

x_  *  0 

u-  *  6 

3 

3  t 

1  3 


x4  -  0 
*  H. 

Combining  equations  (2.1)— (2. 7)  yields  the  fifth-order  nonlinear  system  below 

X1  "  x4~Mx^  [2  0X2StC2o  +  C£axl  +  C£fu2J~Wcos  (x3~xl)1 

X2  "  M  [_Wsln  (x3_xl)  "2  px2StCdo+Cdc£CC£o+C£aXl+C£fu2)  + Cdfu2J 
+  Ne(Ct0  *  Ccvx2  +  CthX5  +  CtvhX2X5>  <Cbo  +  V  +  S.'s 

+  VV  +  V  +  Vt5  +  Cp«Nu3)>> 


■*,  »V, 
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Table  2.2.  Aircraft  parameters 


c 

0 

a 

0.0765 

C 

po 

* 

29.92 

C 

a 

a 

4.62 

Cph 

* 

-0.0009 

C  f 

m 

0.365 

C 

pn 

a 

-0.00076 

Cdo 

a 

0.026 

Cpnt 

a 

-0.0165 

'dc 

a 

0.062 

Cbo 

- 

-352.3 

Cdf 

a 

0.021 

Cbn 

3 

0.1155 

C 

mo 

a 

0.1 

Cbp 

- 

10.8 

me 

= 

-0.0529  +  x  /c 
eg 

Cbh 

a 

0.0025 

C 

me 

a 

-0.0354 

Cto 

= 

3.5 

Cmf 

a 

-0.0368 

Ctv 

a 

-0.00642 

'bhp 

* 

2.11 

Cth 

3 

-4.73  x 10 

Ctvh 

3 

8.7  x  10~8 

N  =  2500  rpm 
Ne  -  2 

p  »  0.004842  slugs/ft8 

S  -  180  ft2 

x  -  0.2  ft 

eg 

c  ■  5  ft 
W  -  4000  lbs 

2 

IyY  =  2050  slugs  ft 


X3  "  x4 

X4  "  (2  px2Sc)[Cmo  +  Cmc£(Cio+C)laxl+CZfu2)  +  Cmeul 

+  CmfU2  "2xJ  (xl+x4)] 

Xg  *  X2  sin  (x^-x^)  . 


(2.9) 


2.2.  Linearization 

To  get  the  linearized  plant  equations,  we  must  first  find  the  equili¬ 
brium  point.  The  equilibrium  states  are  specified  by  (2.8).  To  obtain  the  equi¬ 
librium  controls,  one  must  solve  the  system  of  equations 

x  =  f (x  ,u  ) . 
e  e  e 


From  x^  «  0  we  obtain 


U2e  "  Caf  [QS  "  CIq  "  C2.aao] 


(2.10) 


From  x.  ■  0  we  obtain 
4 


u,  *  [C  +C  .C.  +C  cu,  ]. 
le  C  mo  me*.  I  mf  2e 
me 


(2.11) 


From  x^  *  0  we  obtain 


where 


-» Icbo+ cb.ep.+»<cta4<:b,c».>+<Sh+cb»c,h>H»-^:  cd] 


C^pCpntN  do  bp  po  bn  bp  pn  Dh  bp  ph  Tbhp 


(2.12) 


.  1  2 
q  *  2  ox2 

Ct  ■  Cto  +  Ciaxl  +  C«u 2 
Cd  '  Cdo  +  Cdc«C?  +  Cdfu2 


Tbhp  -  ^(Ct0  +  Ctvx2  +  Cthx5  +  Ctvhx2x5). 

Plugging  in  the  values  of  the  equilibrium  states  from  (2.8)  and  the  various 
coefficients  from  Table  2.2,  we  get  the  equilibrium  controls  as 


< 


12 


u,  -  2.2344 
le 

u2e  -  0.4798  (2.13) 

u,  -  0.1816. 

3e 

The  linearized  system  is  now  obtained  using  the  first  order  perturbation 
techniques . 

Given  the  nonlinear  system 

x  *  f (x,u) . 


Its  linearized  representation  about  the  equilibrium  point  (xe,ug)  is  given  by 

x  ■  Ax  +  Bu 


where 


A 


3f 

3x 


x 

e 


* 


u 

e 


3f 

9u 


X  ,  u 
e  e 


The  elements  of  the  A  and  B  matrices  are  listed  in  Tables  2.3  and  2.4 


respectively. 

Plugging  in  the  numerical  values  from  (2.8),  (2.13),  and  Table  2.2, 
the  lineariz’ed  representation  of  the  airplane  model  is  obtained  as 


”-3.1 

-0.18 

0 

1 

o" 

0 

-0.25 

0 

0.14 

-0.07 

-0.32 

0 

0 

0 

-0.04 

-0.16 

0 

0 

0 

1 

0 

x  + 

0 

0 

0 

-0.74 

0.09 

0 

-1.02 

0 

-1.37 

-1.49 

0 

_-1.91 

0 

1.91 

0 

0_ 

0 

0 

0 

The  states  x^  and  x^  have  been  scaled  down  by  factors  of  100  and  1000 
respectively  to  facilitate  implementation. 


13 


Table  2.3.  Linearized  'A*  coefficients 


a  «  --9§_c 
11  MX2e  la 


a  ,  _  PS  c  ._JL_ 
12  2M  *  MX2e 

al4  ’  1 


£  21  “  S  "  2Q  M  CdcilCJlaCi 


»22--X2«Cdf +Se<Ctv+Ctvh1‘5e)  ^ 


a23  *  -» 


a25  '  T  [(Cth  +  Ctvha2e)Bh',  +  Tbh'>(Sh*CbpCp>.)1 

a41  "  I~  <CmcJCl»'2l^  ail* 
px_  Sc 

a  m  —ts —  [c  +c  r  +C  .C.  x,  +C  u, 

42  L™.  mo  mc£  lo  raci.  la  le  me  le 

Sc2p  °^2e 

+  (Cmc£CZf +  Cmf)u2ej  +  41^  (_2x4e+  M 

a  „  _  -QSP-2  -  a 

43  2IyYx2e  13 


a _ 2 §£ 

a44  I^x 


2e 


i,,  *  -x- 
51  2e 


a53  "  X2e 


a13  "  a15  "  a24  ”  a31  *  a32  *  a33  ”  a35  "  a45  “  a52 
'  a54  '  a55  *  0 


SC 
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3.  CONTROLLER  DESIGN 

In  chls  section,  a  controller  Is  designed  for  the  aircraft,  applying 
the  techniques  of  optimal  control  theory.  Two  design  methodologies — singular 
perturbation  theory  and  output  regulator  theory — are  studied  and  applied  for 
designing  the  aircraft  control  system.  Here,  while  discussing  the  two 
techniques,  only  the  main  results  directly  applicable  to  our  design  problem 
are  given.  The  details  are  in  references  [4]- [8]. 


3.1.  Singular  Perturbation  Theory 

First,  the  general  design  steps  are  given,  and  then,  these  are 
directly  applied  to  the  aircraft  control  problem. 


3.1.1.  General  problem 

The  problem  considered  here  is  not  the  most  general  problem  which 
has  been  solved  in  singular  perturbation  literature.  This  is  a  more  specific 
case  which  is  directly  applicable  to  our  aircraft  control  problem. 

Given  a  system  which  can  be  described  by  a  set  of  differential 


equations  of 

the  following  form 

Z1  "  *11*1  +  A12Z2  +  Blu; 

zl(°)  - 

z10 

yZ2  '  A21Z1  +  A22Z2  +  B2u; 

z2(0)  - 

Z20 

where 

nl  n2  m 

z^gR  ,  z2€R  ,  ue  R  ,  and 

0<  u«  1 

and  the  performance  index 

1  * 

J  m  ~2  f  (z{Qizi  +  u*Ru)dt 


(3.1) 


(3.2) 
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where 

Qx  »  Q'  >  0  and  R  -  R'  >  0. 

It  is  desired  to  obtain  a  feedback  control  u»Fz,  such  that  the  performance 
index  (3.2)  is  minimized  and  the  closed  loop  is  asymptotically  stable.  It  is 
assumed  that  the  matrix  A22  Is  stable. 

The  reduced  order  model,  or  the  'slow  subsystem'  is  obtained  by 
setting  u  ■  0 


Z  -  A  Z  +  B  u  ;  Z  (0)  -  Z.rt 
s  os  os  s  10 


.-1, 


Z2  "  "A22(A21Zs  +  B2Us) 


(3.3 


where , 


.-1. 


Ao  ”  ^1 "  Ai2A22A21 
-1 


Bo  "  B1  -  A12A22B2 
Js  *  2  ^  <‘>s  +  Wdt* 


(3.4 


It  is  well  known  from  optimal  control  theory,  that  the  optimal  control  for 
(3.3),  (3.4)  is  given  by 


u  -  -R'Vk  Z 
s  o  s  s 


(3.5 


where  is  the  positive  definite  solution  of  the  algebraic  Riccati  equation 


a’k  ha  +q-kbr"Vk  -  0. 

os  so  so  os 


(3.6 


Moreover,  the  control  (3.5)  when  applied  to  the  system  (3.3)  makes  it  asymp¬ 
totically  stable. 

Singular  perturbation  theory  goes  on  to  show  that  if  we  apply  the 


-  FZ, 


control 


u  -  -r"Vk  Z, 


(3. 


to  the  system  (3.1),  then  provided  A22  is  stable,  there  exists  a  0<y*«l 
such  that  the  closed-loop  system  is  asymptotically  stable  for  any  y€  [0,y*], 


and  also 


J  (opt)  *  J (opt)  +  0(y). 
s 


(3.8) 


The  solution  to  (3.1),  with  the  control  (3.7),  is  approximated  for  all  finite 
t> 0  by 


Z.(t)  -  exp[ (A  +  B  F) t]Z  (0)  +  0(y) 

1  o  o  s 

Z2(t)  =■  -A22(A22+B2F)exp[(Ao+BoF)t]Zs(0) +  exp[A22t/y]Zf(0) +0(y) 
where, 

V°>  ‘  Z10 

Zf(0)  -  Z20-Z2(0).  (3.9) 


3.1.2.  Aircraft  controller  design 

The  linearized  plane  equations  as  given  by  (2.14)  are 


-3.1 

-0.18 

0 

0 

0 

0 

-0.25 

0 

0.14 

-0.07 

-0.32 

0 

0 

0 

-0.04 

-0.16 

0 

0 

0 

0 

0 

X  + 

0 

0 

0 

-0.74 

0.09 

0 

-1.02 

0 

-1.37 

-1.49 

0 

_-1.91 

0 

1.91 

0 

0 

0 

0 

0  _ 

(3.10) 


The  eigenvalues  of  the  open  loop  system  are 

0,  -0 .02  +  jO .18 ,  -1.52,  -2.62. 

This  indicates  that  (3.10)  possesses  a  two-time-scale  property.  Hence  we  can 
represent  (3.10)  in  the  form  (3.1). 
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An  examination  of  the  zero-input  response  of  (3.10)  indicates  that 
the  states  x^,  and  x^  can  be  considered  as  'slow'  variables,  and  the 
states  x^  and  x^  can  be  considered  as  'fast'  variables.  Introducing  a 
fictitious  parameter  u=0.05,  the  system  (3.10)  can  be  put  in  the  form  (3.1) 
as  follows 


-0.07  -0.32  0 

0  0  0 
0  1.91  0 


uz. 


1 

0.14 

o*l 

0  -0.04 

-0.16 

+ 

H 

N 

- 1 

0 

-1.91 

O 

1 _ 

Z2  + 

0  0 

_0  0 

0 

0 

-0.009  0 

o’ 

21  + 

’-0.155 

0.05 

0 

-0.125  0 

0.0045  0 

0 

1 

-0.037 

-0.051 

2 

-0.0685 

-0.0745  0 

- 

L 

where , 


2^—  £x2  x3  x^] 

Z2  "  fxl  V* 


The  performance  index  is  chosen  to  be 

oo 

J  *  \  I  (Z|Q21  +  u’Ru)dt 
o 

3x3 

Q  »  R  »  I  . 

Letting  u-*-0,  we  obtain  the  slow  subsystem  as 


-0.07 

-0.32 

0 

-0.05 

-0.1 

-0 . 16 

z  * 

0.11 

0 

0 

z  + 

-1.09 

-1.14  0 

s 

s 

0.05 

1.91 

0 

0.67 

0.85  0 

solution 

oi  the  algebraic 

Riccati  equation 

(3.6)  is 

~4 

.29 

0.27 

0.71 

K  - 

0 

.27 

2.75 

1.6 

s 

_0 

.71 

1.6 

1.49  _ 

(3.11) 


(3.12) 


(3.13) 


(3.14) 
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Hence,  from  (3.7)  we  obtain 


0.03  1.93  0.78 

0.14  1.79  0.62 

0.69  0.04  0.11 


(3.15) 


Therefore,  the  partial  state  feedback  to  be  applied  to  the  original  nonlinear 
plane  (2.9)  is  given  by 

U1  -  2.2344  +  0.03(x2-x2s)  +  1.93(x3-x3s)  +  0.78(x5-x5g) 

0,  *  0.4798  +  0.14(x,-x,  )  +  1.79(x,-x,  )  +  0.62(xc-xc  ) 

2  2  2s  3  3s  5  5s 

U3  ■  0.1816  +  0.69(x2~x2g)  +  0.04(x3~x3s)  +  O.lKx^-x.  ) .  (3.16) 

The  closed  loop  eigenvalues  of  the  linearized  system  (3.10)  with  the  control 
(3.15)  are 

-0.17,  -0.28 + jl.98,  -1.34,  -2.23. 

For  x^ *  [1  0  1  1  0],  the  value  of  the  performance  index  (3.12)  with  the 

control  (3.15)  is  obtained  as 

J  =  6.53. 
s 


This  is  to  be  compared  with  the  optimal  cost  obtained  on  solving  the  full  state 


regulator  problem. 


J(opt)  ■  6.27. 


The  controller  designed  above  is  alright  if  the  airplane  trajectory  is  to  be 
regulated  to  the  equilibrium  flight  conditions  given  by  (2.8)  in  the  absence  of 
any  disturbances.  If  there  are  any  disturbances  present,  then  satisfactory 
regulation  will  not  be  achieved  in  general.  Also  with  the  above  controller, 
it  is  not  possible  to  'force'  the  desired  states  to  any  other  set  points. 
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In  order  to  account  for  constant  disturbances  and  to  be  able  to  regulate  the 
states  to  other  set  points,  an  integral  controller  is  to  be  incorporated. 

Since  the  states  of  interest  are  the  velocity,  pitch  angle,  and 
altitude,  three  new  states  are  defined  as 


8 


x„  -  v  c 
2  ref 


x,  -  9  , 

3  ref 

x,  -  H 
5  ref 


(3.17) 


These  new  states  are  also  considered  as  slow  variables.  The  augmented  system 
put  in  the  form  (3.1)  is  (with  u  =  0.05). 


0 

0 

0 

1 

0 

o" 

0 

o' 

"o 

0 

0 

0 

0 

0 

0 

1 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

1 

Z1  + 

0 

0 

2?  + 

0 

0 

0 

0 

0 

0 

-0.07 

-0.32 

0 

1 

0.14 

0 

L 

0 

-0.04 

-0.16 

0 

0 

0 

0 

0 

0 

0 

1 

0 

0 

0 

_0 

0 

0 

0 

1.91 

0 

-1.91 

0 

0 

0 

0 

uz„ 


where. 


0  0  0 

-0.009  0 

0 

z,  + 

-0.155 

0.05 

z  + 

2  * 

0 

-0.125 

0 

0  0  0 

0.0045  0 

0 

1 

-0.037 

-0.051 

-0.0685 

-0.0745 

0 

L 

Z1  " 

[x 

6  X7 

Xg  X2 

x3  x5r 

[xx  x4]\ 


(3.18) 


The  performance  index  is  chosen  to  be 

00 

J  *  j  /  (zjQz  +u'Ru)dt 
o 


where 


r6*6 
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0.1 

0 

0 


0 

0.5 

0 


Letting  u-*-0,  we  obtain  the  slow  subsystem  as 


0 

0 

0.1 


(3.19) 


"o 

0 

0 

1 

0 

o' 

0 

0 

0 

0 

0 

0 

0 

1 

0 

0 

0 

0 

0 

0 

0 

0 

0 

1 

0 

0 

0 

(3.20) 

z  * 

z  + 

u 

s 

0 

0 

0  - 

■0.07  ■ 

-0.32 

0 

s 

-0.05 

-0. 

1 

-0.16 

s 

0 

0 

0 

0.11 

0 

0 

-1.09 

-1. 

14 

0 

0 

0 

0 

0.05 

1.91 

0 

0.67 

0. 

85 

0 

Based  on  this 

reduced 

.  order 

model 

,  the  near-optimal  control  is 

obtained 

as 

- 

■0.47 

-0.28 

3.11 

0.01 

9.44 

6.64 

u  = 

0.11 

1.4 

0.14 

0.16 

0.86  ■ 

-0.12 

V 

(3.21) 

3.12 

-1.28 

0.44 

6.67 

0.49 

1.29 

The  eigenvalues  of  the  linearized  closed  loop  system  with  the  control  of  (3.21) 
are 

-0.11,  -0.23  + j  3. 3,  -0.56  + jO. 43,  -0.89,  -1.34  +  J1.04. 

For  [1  0  1  1  0  0  0  0],  the  value  of  the  performance  index  (3.19)  with 

the  control  (3.21)  is  obtained  as 


J  -  16.54. 
s 

This  is  to  be  compared  with  the  optimal  cost  obtained  on  solving  the  full 
state  regulator  problem 


J(opt)  ■  15.89. 


The  partial  state  feedback  to  be  applied  to  the  original  nonlinear  plant  (2.9), 
(3.17)  is  given  by 
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*  2.2344  -  0.01(x2“X2g)  +  9.44(Xg-X2s)  +  6.64(x2~x^g)  -  0.46x^  -  0.28x^  +  3.11xg 

U0  *  0.4798  +  0. 16(x0-x0  )  +  0.86(x,-x»  )  -  0.12(x,-x,  )  +  O.llx,  +  1.4x,  +  0.14xQ 

2  2  2s  3  3s  5  5s  6  7  8 

U,  -  0 . 1816  +  6.67 (x.-x-  )+0.49(x,-x,  )  +  1.29(x--xe  )  +  3.12x,  -  1.28x_  +  0.44x. 

3  2  2s  3  3s  5  5s  6  7  8 

(3.22) 


3.2.  Output  Regulator  Theory 

Here  again,  the  general  design  steps  are  given  first  and  then  these 
are  directly  applied  to  the  aircraft  control  problem. 


3.2.1,  General  problem 
Given  the  system 


21  "  A11Z1  +  A12Z2  +  Blu; 

Z1<0)*Z10 

Z2  =  A21Z1  +  A22Z2  +  B2u; 

Z2(0)-Z20 

y  m  zi 

where 

z1e  Rn,  z2e  Rr,  ue  Rm 

and  the  performance 

index, 

00 

J  -  |  /  (z{Qzi + u'Ru)dt 

0 

where 

Q-Q’>0  and  R=R’>0.  (3.24) 

It  is  desired  to  find  a  control 

u  x  Ky 

which  minimizes  (3.24).  In  order  to  find  K,  we  proceed  as  follows. 

First,  the  full  state  regulator  problem  for  (3.23),  (3.24)  is  solved.  Define 
S  *  BR  *B'  and  FxA-SMc>  where  is  the  positive  definite  solution  of  the 
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algebraic  Riccati  equation 


A'M  +  M  A  +  Q-M  BR-1B 'M  -  0 
c  c  c  C 


(3.28) 


and 


\l 

A 12 

;  B  - 

X 

_A21 

A22 

_B2 

Let  x 


,  Y€  R  consist  of  the  subset  of  r  eigenvectors  of  F 


associated  with  a  particular  subspectrum  A  that  we  wish  to  retain  in  the 
output  regulator. 

It  has  been  shown  in  [3]  that,  if,  for  some  A  ,  the  matrix 
Ar*A22-NA^2«  where  N ■  ZY  \  is  stable;  then  there  exists  a  unique  output 
feedback  gain  matrix  K  such  that  the  closed  loop  system  A^  is  asymptotically 
stable,  and 

A(A  )  -  A  UA(A  ). 
c  r  r 

The  optimal  control  is  given  by 


u  -  -R_1B'M  Py 
c 


(3.26) 


where 


The  cost  matrix  associated  with  the  control  (3.26)  is 


M  -  M  +  V’D  V 
o  c  o 


(3.27) 


where 


V  -  (-N  I] 


and  Dq  is  the  unique  positive  definite  solution  of  the  Lyapunov  equation 
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A'D  +  D  A  +  G 
r  o  or  o 


(3.28) 


where 


(0  I]M  SM  [0 
c  c 


I]’ 


3.2.2.  Aircraft  controller  design 

The  linearized  plant  equations  gi  m  by  (2.14)  are  put  in  the  form 

(3.23), 


"-0.07 

-0.32 

o' 

~  0.14 

o" 

r— 

0 

-0.04 

-0.16" 

1 

- 

0 

0 

0 

Z1 

+ 

0 

1 

z 

2  + 

0 

0 

0 

u 

0 

1.91 

0_ 

-1.91 

» 

0 

0 

0 

0 

-0.18 

0  0 

- 

3.1 

1 

- 

0 

-0.25 

o" 

= 

z 

,  + 

29 

+ 

0.09 

0  0 

1 

m 

0.74  - 

1.02  j 

2 

_-1.37 

-1.49 

0 

where 


y  *  z. 


z1  «  [x2  x3  x5] ’ 

z2  *  [xl  x41’* 


The  performance  index  is  chosen  to  be 

00 

J  -  y  /  (Z^QZ1  +  u’Ru)dt 


(3.29) 


Q  -  R  -  I3x3. 


(3.30) 


Solving  (3.25)  we  obtain  the  cost  for  the  full  state  regulator  problem  as 
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4.28 

0.27 

0.68 

-0.24 

0.02 

0.27 

6.75 

2.78 

-1.86 

1.83 

0.68 

2.78 

1.87 

-1 

0.57 

-0.24 

-1.86 

-1 

0.61 

-0.44 

_  0.02 

1.83 

0.57 

-0.44 

0.64_ 

”-0.19 

-0.42 

-0.04 

0.17 

-0.03 

0 

0 

0 

0 

1 

’M  - 

0 

1.91 

0 

-1.91 

0 

c 

-0.22 

-0.57 

-0.16 

-2.97 

0.79 

-0.16 

-6.82 

-1.99 

0.87 

-3.47 

The  eigenvalues  of  F  are 


-0.17,  -1.03+ jl. 22,  -1.81,  -2.59. 

It  was  found  that  the  only  set  of  3  eigenvalues  which  can  be  retained  while 
satisfying  the  sufficient  condition  for  output  stabilizability  are 


-1.03  + jl. 22,  -1.81. 


The  components  of  the  corresponding  eigenvectors  are 


6.53 

-0.69 

3. 98~ 

~9.03 

15.84 

-19.02~ 

Y  - 

18.36 

-19.49 

13.28 

;  z  - 

_4.95 

42.39 

-24.03_ 

_-39.59 

18.68 

-34.11_ 

N  - 


14.25  1.3  2.73 

17.54  -0.25  2.65 


A22-NA12 


0.11  -0.3 

1.87  -0.77 


A(Ar)  -  -0.33  + jO. 6. 
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Hence,  being  stable  the  sufficient  condition  is  satisfied 


P 


10  0 
0  10 
0  0  1 
14.25  1.3  2.73 

17.54  -0.25  2.65 


Hence,  the  output  feedback  gain  matrix  is 


K  -  P  - 

c 


6.67 

1.5 

1.43 

7.47 

1.39 

1.43 

0.2 

-0.01 

0.01 

G  »  [0  I]M  SM  [0  I]’ 

o  c  c 


0.64  -0.97 

-0.97  1.47 


The  solution  of  (3.28)  is  obtained  as 


D 

o 


4.87  -0.46 

-0.96  1.13 


V  -  [-N 

-14 

I]  - 

-17 

.25  ■ 

.54 

-1.3  -2. 

0.25  -2. 

73  1 

65  0 

0 

• 

1. 

Hence, 

from  (3.27)  we  obtain 

1104 

75.88 

201.9 

-60.97 

-13.35 

75.87 

15.27 

17.89 

-8.24 

2.7 

M 

0 

-  M  +V’D  V  - 
c  0 

201.9 

17.89 

39.17 

-12.96 

-1.188 

-60.97 

-8.24 

-12.96 

5.43 

-0.895 

-13.35 

2.7 

-1.188 

-0.895 

1.77 

Therefore,  from  (3.26)  we  obtain 
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_ 6 .67 

1.5 

1.43 

7.47 

1.39 

1.43 

0.2 

-0.01 

0.01 

The  eigenvalues  of  the  linearized  closed  loop  system  are 


(3.31) 


-0.33  +  J0.6,  -1.63  +  J1.22,  -1.81. 

For  x^  *  [1  0  1  1  0],  the  optimal  cost  with  full  state  feedback  is 

J(opt)  ■  6.27. 

The  cost  with  the  control  (3.31)  is 

J  -  1405. 

It  is  to  be  noted  here  that  the  difference  in  the  two  costs  is  more 
when  the  controller  is  designed  based  on  output  regulator  theory  as  compared 
with  the  difference  when  it  is  designed  based  on  singular  perturbation  theory. 
This  is  explained  later  after  studying  their  performance  in  real-time 
implementation . 

The  partial  state  feedback  to  be  applied  to  the  original  nonlinear 
plant  (2.9)  is  given  by 

U.  *  2.2344  +  6.67(x»-x0  )  +  1.5(x_-x,  )  +  1.43(x_-x,  ) 

1  2  2s  3  3s  5  5s 

U-  *  0.4798  +  7.47(x_-x„  )  +  l,39(x,-x,  )  +  1.43(x,-x,  ) 

2  2  2s  j  os  5  3s 

U3  -  0.1816  +  0.2(x2-x2g)  -  0.01(x3-x3g)  +  0.01(x5-x5  ).  (3.32) 

As  before,  a  PI  controller  is  now  designed  by  augmenting  the  plant 
with  the  three  new  states  defined  by  (3.17).  The  augmented  system  put  in  the 
form  (3.23)  is 
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0  0  0 
0  0  0 
0  0  0 


000  -0.07  -0.32  0 


0  0  0 
0  0  0 


1.91  0 


0  -0.04  -0.16 


000  -0.18  0  0  -3.1  1  0  -0.25  0 

z  +  z  + 

000  0.09  0  0  1  -0.74  -1.02  -1.37  -1.49  0 


y  -  z. 


where 


21  "  tx6  x7  x8  x2  x3  *5J' 
*2  -  [x2  x4)'. 


(3.33) 


The  performance  index  is  chosen  to  be 


where 


00 

J  *  y  /  (z;[Qz1  +  u'Ru)dt 


0.1  0  0 

R  *  0  0.5  0  and  Q*  1^*^. 

0  0  0.1 


On  solving  the  state  regulator  problem,  the  closed  loop  eigenvalues  are 
obtained  as 

-0.1,  -0.56  + jO. 43,  -0.99,  -1.43  +  J1.82,  -2.32  +  J0.23. 

Retaining  the  first  six  eigenvalues  in  the  output  regulator,  we  get 


(3.34) 


N  -  ZY 


-0.75  1.05  5.83  -0.24  8.1  8.54 


-1.4  1.87  10.7  -0.41  12.43  14.88 
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Ar  *  A22“NA12 


12.35  -7.1 

27.75  -13.45 


A(A  )  -  -0.1  +  J4.35 


-0.75  1.05  5.83  -0.24  8.1  4.54 

-1.4  1.87  10.7  -0.41  12.43  14.88_ 


Therefore,  from  (3.26),  we  obtain 


u  -  -0.49  2.23  4.92 


7.68 

-0.14 

12.5 

4.92 

0 

6.79 

-2.2 

6.74 

-3.19 

-0.14 

12.6 

11.97' 

0 

6.79 

6.58 

6.74 

-3.19 

-2.56 

The  eigenvalues  of  the  linearized  closed  loop  system  are 

-0.1,  -0.1  + j4.35,  -0 . 56  +  jO  .43 ,  -0.99,  -1.43  + jl. 82. 


(3.35) 


x'  -  [1  0  1  1  0  0  0  0], 

O 

the  optimal  cost  with  full  state  feedback  is 

J(opt)  ■  15.89. 

The  cost  with  the  control  (3.35)  is 


J  -  23.56. 
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It  is  to  be  noted  here  that  the  difference  in  the  two  costs  is  not  so  much 
as  was  in  the  previous  case  with  no  integral  control.  This  is  because  now 
we  were  able  to  retain  all  the  'small'  eigenvalues  in  the  output  regulator 
as  opposed  to  the  last  design  where  this  could  not  be  possible. 

The  partial  state  feedback  to  be  applied  to  the  original  nonlinear 
plant  (2.9),  (3.17)  is  given  by 

*  2.2344  -  0 . 14(x2~x2g )  +  12. 6(xg-x2s )  +  11 .  97(x^-x,-g  )-l  .07xg  +  0. 37x^  +  7 . 68xg 
U2  *  0.4798  +  6. 79(Xg-Xgg)  +  6 . 58 (x^-x^ )  -  0.49xg  +  2.23x^  +  4.92xg 
Ug  *  0.1816+6.74  (x2~x2s )  -  3.19  (xg-xgg )  -  2 . 56  (x5-x,.g )  +  3 . 45xg  -  0 . 8x^  -  2 . 2xg . 

(3.36) 

The  controllers  have  been  designed  based  on  a  continuous- time  model  of  the 
plant  as  opposed  to  a  discrete  model  which  would  have  been  more  appropriate. 

This  was  done  because  it  was  not  known  beforehand  what  sampling  period  would 
be  used;  and  also  due  to  the  fact  that  when  sampled  fast  enough,  the  response 
from  real-time  implementation  would  closely  approximate  the  response  from 
simulation  of  the  continuous-time  system. 
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4.  REAL  TIME  IMPLEMENTATION 


4.1.  Simulation 

All  preliminary  simulation,  to  get  the  analytical  results  for  all 
the  controllers  just  derived,  was  done  on  the  CYBER  175  digital  computer. 
Computer  programs  had  to  be  written  to  perform  all  of  the  integrations  and 
other  related  operations  needed.  Because  of  the  size  of  the  program  and  the 
need  for  versatility  of  input  data,  an  interactive  format  was  utilized.  This 
method  of  having  the  operator  respond  to  different  options  (e.g.  initial 
conditions)  helped  facilitate  debugging  of  the  program  also.  Furthermore,  this 
made  it  possible  to  study  any  flight  condition  by  a  simple  response  to  a  para¬ 
meter  change  option.  The  only  true  shortcoming  involved  here  was  that  the 
program  did  not  have  the  option  of  generating  feedback  matrices  (these  were 
obtained  beforehand  using  the  LINSYS  [10]  and  LAS  packages)  so  the  responses  to 
different  conditions  (other  than  the  initially  chosen  one)  were  suboptimal  in 
some  sense. 

All  i  the  interactive  programming  and  condition  organization  was 
done  with  one  main  program.  This  program  would  ask  for  the  desired  flight 
conditions  and  would  then  make  calls  to  the  various  subprograms  needed  to 
facilitate  these.  The  subprograms  would  then  execute  the  different  commands 
such  as  for  integration  or  plots.  Integrations  were  performed  using  subroutines 
from  IBM’s  IMSL  package  and  the  plots  were  obtainec  .ng  the  CALCOMP  plotting 


package. 


4.2.  Implementation 


The  AD-5  analog  computer  had  the  nonlinear  aircraft  plant  equations 
patched  onto  it,  thus  simulating  the  dynamics  of  a  real  time  airplane.  This 
required  a  lot  of  manipulation  and  scaling  due  to  the  limited  amount  of 
hardware  available,  and  due  to  saturation  restrictions. 

To  help  set  up  and  test  this,  several  PDP-11  programs  were  used. 
Again,  here,  the  programs  were  set  up  interactively,  so  any  flight  conditions 
could  be  simulated.  But  again  due  to  scaling  and  hardware  limitations,  there 
was  actually  only  a  limited  range  of  variations  possible.  For  accuracy  and 
speed  of  setting  up,  a  subroutine  was  written  to  calculate  and  set  all 
values,  automatically,  according  to  what  parameters  were  desired.  The  analog 
diagram  is  shown  in  Figure  4.1. 

The  software  for  the  digital  controller  was  written  in  Z-80 
assembly  language.  The  program  was  assembled  on  the  DEC-10  and  the  code  was 
downloaded  directly  into  the  specified  RAM  area  of  the  microcomputer.  The 
microcomputer  itself  was  interfaced  with  the  AD-5  through  a  set  of  A/D  and  D/A 
converters.  There  were  8  ports  (of  8  bits  each)  of  A/D  and  D/A  converters 
used  for  inputing  the  desired  states  and  outputing  the  control  signals. 

The  sampling  period  was  set  at  1  msec.  This  was  done  by  writing  an  interrupt 
routine  which  used  the  internal  clock  of  the  system  to  interrupt  the  A/D 
ports  every  1  msec  to  read  the  input  data.  To  obtain  the  plots,  the  PDP-11  - 
DEC-10  system  was  used.  The  PDP-11  would  sample  and  store  the  desired  response 
values  (states  and  controls)  every  1  msec.  These  were  later  transferred  to 
the  DEC-10  so  that  the  AG210  subroutines  could  be  used  to  plot  the  data. 


re  4.1a.  Mathematical  block  diagram  of  the  test  syst 


Set  Points:  Vel  Pitch  Alt 


4.1b.  Functional  Block  diagram  of  the  test  system. 
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4.3.  Results  and  Discussions 

Four  sets  of  curves  are  plotted  for  each  of  the  two  controllers. 

The  first  is  just  the  proportional  controller  at  the  nominal  operating  point; 
the  second  is  the  Pi-controller  at  the  nominal  operating  point;  and  the  third 
and  fourth  are  Pi-controllers  at  two  different  set  points.  These  curves  are 
shown  in  Figures  4. 2-4. 5. 

In  the  discussions  below,  the  controller  designed  via  singular 
perturbation  theory  is  referred  to  as  controller  A,  while  the  controller 
designed  via  output  regulator  theory  is  referred  to  as  controller  B. 

Figure  4.2  shows  the  system  response  with  the  proportional  controller. 
A  quick  examination  of  the  curves  indicates  that  controller  B  performs  much 
poorer  than  controller  A.  The  state  responses  with  controller  B  are  more 
oscillatory  and  take  a  longer  time  to  reach  the  steady  state  as  compared  to 
the  state  responses  with  controller  A.  Moreover,  the  stability  region  around 
the  nominal  flight  trajectory  is  much  smaller  with  controller  B  than  with 
controller  A.  It  was  found  that  with  controller  B,  the  system  would  go 
unstable  if  the  initial  velocity  lies  outside  180-215  ft/sec,  or  if  the 
initial  pitch  angle  lies  outside  +0.6°,  or  if  the  initial  altitude  lies 
outside  1880-2100  ft.  The  corresponding  ranges  with  controller  A  were 
found  to  be  150-250  ft/sec,  +  1.4°,  1500-2500  ft.  In  terms  of  the  control 
effort,  all  the  three  controls  fluctuate  more  rapidly  with  controller  B  than 
with  controller  A.  The  poorer  performance  of  controller  as  compared  to 
controller  A  was  to  be  expected  because  of  the  ill-conditioning  of  the  output 
regulator  design  in  this  case  (as  noted  in  the  last  chapter). 


Velocity  (ft/sec) 


2.6  xlO3 


Figure  4.2.3a,.  Singular  perturbation  design. 


Figure  4.2.3b.  Output  regulator  design.  fp-6823 
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FP-6826 
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Figure  4.2.6a.  Singular  perturbation  design. 


Figure  4.2.6b.  Output  regulator  design. 


PP-6828 


Figure  4.3.1b.  Output  regulator  design. 


Figure  4.3.  Pi-controller  at  nominal  set  point. 
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Figure  4.3.3a.  Singular  perturbation  design. 


Time  (sec) 

Figure  4.3.3b.  Output  regulator  design. 
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Figure  4.3.5a.  Singular  perturbation  design. 


Figure  4.3.5b.  Output  regulator  design. 
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3.6b.  Output 
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Figure  4.4.2b.  Output  regulator  design. 
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Figure  4.4.3b.  Output  regulator  design. 
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Figures  4. 3-4. 5  show  the  system  responses  with  the  dynamic  PI 
controllers.  A  quick  examination  of  these  curves  indicates  that  at  least  in 
terms  of  the  state  responses  the  two  controllers  perform  equally  well.  At  the 
nominal  operating  point  (Figure  4.3),  the  stability  regions  with  the  two 
controllers  are  almost  identical.  It  was  found  that  the  stabilitv  region 
is  enclosed  within  the  boundaries  150-250  ft/sec,  +3.5°,  1700-2400  ft. 

There  were  larger  overshoots  in  velocity  and  altitude  responses  with 
controller  A  than  with  controller  B;  whereas  the  overshoot  in  the  pitch  angle 
was  larger  with  controller  B  than  with  controller  A.  Controller  B  required  a 
much  larger  control  effort  than  controller  A,  which  may  prove  to  be  an 
undesirable  feature  in  real  time  applications. 

At  a  trajectory  which  forms  an  'upper  envelope'  to  the  nominal 
trajectory  (Figure  4.4),  the  performance  of  the  two  controllers,  in  terms  of 
state  and  control  responses,  is  identical  to  their  performance  at  the  nominal 
trajectory.  The  stability  regions  in  this  case  were  170-300  ft/sec,  +3°, 
2000-2500  ft. 

At  a  trajectory  which  forms  a  'lower  envelope'  to  the  nominal 
trajectory  (Figure  4.5),  controller  B  is  seen  to  perform  significantly  better 
than  controller  A  in  terms  of  overshoot  and  settling  time  of  the  state 
responses.  The  control  effort  required  is  also  smaller  in  magnitude  with 
controller  B  than  with  controller  A,  although  the  control  responses  are  not 
quite  'smooth.'  The  stability  regions  with  the  two  controllers  were  almost 
identical  and  were  found  to  be  130-210  ft/sec,  +1.8°,  1650-2000  ft. 

From  the  real-time  testing  of  the  controller  designs,  it  is  seen 
that  when  dealing  with  systems  possessing  a  two-time-scale  property,  output 
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regulator  theory  may  not  provide  a  satisfactory  solution.  If  the  problem  is 
ill-conditioned,  in  the  sense  that  it  is  not  possible  to  retain  all  the  ’small’ 
eigenvalues  in  the  output  regulator,  the  resulting  controller  will  give  a 

performance  poorer  than  that  obtained  by  singular  perturbation  theory.  But, 

/ 

if  the  problem  is  not  ill-conditioned,  then  the  two  techniques  may  given 
comparable  results.  In  such  a  case,  which  design  to  use  would  depend  on  the 
specific  problem,  and  the  priority  of  the  performance  criteria  (like  the  state 
response,  control  effort  or  the  stability  region). 

In  dealing  with  problems  such  as  the  one  treated  in  this  thesis, 
singular  perturbation  theory  would  be  the  better  technique  for  the  controller 
design,  as  it  is  computationally  more  efficient  than  output  regulator  theory. 
Output  regulator  theory  involves  the  solution  of  the  full  state  regulator 
problem  as  a  part  of  the  design  procedure,  which  is  altogether  bypassed  in 
singular  perturbation  theory.  Also,  singular  perturbation  theory  is 
guaranteed  to  give  a  satisfactory  solution.  Output  regulator  theory,  which 
is  based  on  a  sufficient  condition  of  output  stabilizability ,  may  not  be 
applicable  in  many  cases . 

It  is  to  be  pointed  out  here  that  the  above  comments  should  not 
lead  one  to  the  conclusion  that  output  regulator  theory  is  in  any  way  inferior 
to  singular  perturbation  theory.  The  output  regulator  theory  is  applicable  to 
a  much  wider  class  of  problems;  and  the  contention  here  is  that,  when  dealing 
with  systems  possessing  a  two-time-scale  property,  singular  perturbation 
theory  which  specifically  handles  such  problems,  would  give  a  better  solution 
than  output  regulator  theory. 
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A  final  comment  on  the  small  angle  of  attack  approximation  made 
while  arriving  at  the  aircraft  model.  This  assumption  was  shown  to  be 
justified  by  the  real-time  responses,  where  it  was  seen  that  the  angle  of 
attack  never  exceeded  +1.5°. 


) 
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5.  CONCLUSION 

In  this  thesis,  the  applicability  of  two  optimal  control  theories — 
singular  perturbation  theory  and  output  regulator  theory — have  been  examined. 
The  performance  of  these  two  design  methodologies  has  been  judged  in  terms  of 
the  speed  of  regulation  from  initial  conditions  close  to  the  equilibrium 
trajectory,  the  control  effort  required  during  regulation,  the  magnitude  of  the 
stability  region  around  the  equilibrium  trajectory,  and  the  system  behavior 
while  tracking  trajectories  other  than  the  nominal  one  for  which  the  controller 
has  been  designed.  It  was  shown  that,  when  dealing  with  systems  possessing  a 
two-time-scale  property,  singular  perturbation  theory  provides  an  elegant 
solution  to  the  control  problem.  If  the  'fast'  subsystem  is  stable,  then  a 
partial  state  feedback  controller  can  be  designed  based  on  a  reduced  order 
model.  When  dealing  with  such  systems,  output  regulator  theory  will  not  give 
a  satisfactory  solution  if  the  problem  is  ill-conditioned  in  the  sense 
discussed  before. 

In  dealing  with  a  more  general  class  of  problem  (not  tried  here) , 
where  states  that  are  accessible  for  feedback  are  a  combination  of  both  'fast' 
and  'slow,'  a  combination  of  the  two  techniques  may  be  applied.  The  original 
system  may  be  decomposed  into  two  lower  order  subsystems — the  'fast'  and  the 
'slow, '  and  to  each  subsystem  the  output  regulator  technique  may  be  applied. 

The  resulting  controller  will  be  near  optimal,  provided  each  of  the  two  sub¬ 
system  problems  are  well-conditioned  in  the  sense  discussed  before. 

Also,  in  this  thesis,  the  versatility  of  a  microcomputer  system  as 
a  digital  controller  has  been  demonstrated.  Almost  any  complex  controller 
structure  can  be  implemented  using  a  microcomputer  just  by  a  minor  variation 


in  the  software. 
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Since  the  response  at  flight  conditions  away  from  the  nominal 
degrades  rapidly,  it  is  not  feasible  to  use  the  same  feedback  matrix  over 
a  wide  range  of  flight  conditions.  A  simple  thing  to  do  in  such  a  case  would 
be  to  have  a  set  of  precalculated  feedback  matrices  to  be  used  under  different 
flight  conditions.  But,  perhaps  a  more  elegant  solution  would  be  to  do  an 
on-line  estimation  of  the  model  parameters,  and  then  to  continuously  update 
the  feedback  matrix  as  the  flight  conditions  vary.  This  idea  would  probably 
lead  one  to  think  in  terms  of  an  adaptive  control  scheme.  Any  implementation 
of  such  a  scheme  would  require  a  much  more  sophisticated  microcomputer  system 
than  the  one  used  in  this  work  (for  e.g.,  it  must  have  a  hardware  multiplier 
unit  to  speed  up  the  on-line  computations).  The  adaptive  control  technique 
when  applied  to  nonlinear  systems,  like  an  aircraft,  has  had  only  a  limited 
success  so  far,  but  is  quite  possibly  the  method  for  the  future. 
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APPENDIX  A 


The  purpose  of  this  appendix  is  to  provide  adequate  information  on 
the  existing  Z-80  microprocessor.  Here  an  effort  has  been  made  to  collect  the 
important  information  pertaining  to  the  chips '  hardware  and  software  and 
present  it  with  some  comments  on  its  functional  aspect. 


A.l.  Z-80  CPU  Architecture 

A  block  diagram  of  the  internal  architecture  of  the  Z-80  CPU  is 
shown  in  Figure  A.l.  The  diagram  shows  all  of  the  major  elements  in  the  CPU. 


A.  2,  CPU  Registers 

The  Z-80  CPU  contains  208  bits  of  R/W  memory  that  are  accessible  to 
the  programmer.  Figure  A. 2  illustrates  how  this  memory  is  configured  into 
eighteen  8-bit  registers  and  four  16-bit  registers.  All  Z-80  registers  are 
implemented  using  static  RAM.  The  registers  include  two  sets  of  six  general 
purpose  registers  that  may  be  used  individually  as  8-bit  registers,  or  in 
pairs  as  16-bit  registers.  There  are  also  two  sets  of  accumulator  and  flag 
registers . 


A. 2.1.  Special  purpose  registers 

i)  Program  Counter  (PC) :  The  program  counter  holds  the  16-bit  address  of 
the  current  instruction  being  fetched  from  memory.  The  PC  is  auto¬ 
matically  incremented  after  its  contents  have  been  transferred  to  the 


Figure  A.l.  Z80-CPU  block  diagram. 
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Main  Register  Set  Alternate  Register  Set 

- * - v - A - N 


Accumulator 

Flags 

Accumulator 

Flags 
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F 

A' 

F' 
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B' 
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E 

D' 

E' 
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H' 

L' 
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Purpose . 
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Interrupt 
Vector  I 

Memory 
Refresh  R 

Index  Register  IX 

Index  Register  IY 

> 

Stack  Pointer  SP 

Program  Counter  PC 
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Special 

Purpose 

Registers 


FP-6819 


Figure  A. 2.  Z80-CPU  register  configuration. 
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address  lines.  When  a  program  jump  occurs  the  new  value  is  auto¬ 
matically  placed  in  the  PC,  overriding  the  incrementer. 

ii)  Stack  Pointer  (SP) :  The  stack  pointer  holds  the  16-bit  address  of  the 
current  top  of  a  stack  located  anywhere  in  external  system  RAM  memory. 
The  external  stack  memory  is  organized  as  a  last-in  first-out  (LIFO) 
file.  The  stack  allows  simple  implementation  of  multiple  level  inter¬ 
rupts,  unlimited  subroutine  nesting  and  simplification  of  many  types  of 
data  manipulation. 

iii)  Two  Index  Registers  (IX  and  IY) :  The  two  independent  index  registers 
hold  a  16-bit  base  address  that  is  used  in  indexed  addressing  modes.  In 
this  mode,  an  index  register  is  used  as  a  base  to  point  to  a  region  in 
memory  from  which  data  is  to  be  stored  or  retrieved.  An  additional  byte 
is  included  in  indexed  instructions  to  specify  a  displacement  from  this 
base.  This  displacement  is  specified  as  a  two's  complement  signed 
integer. 

iv)  Interrupt  Page  Address  Register  (I) :  The  Z-80  CPU  can  be  operated  in  a 
mode  where  an  indirect  call  to  any  memory  location  can  be  achieved  in 
response  to  an  interrupt.  The  I  register  is  used  for  this  purpose  to 
store  the  high  order  8-bits  of  the  indirect  address  while  the  inter¬ 
rupting  device  provides  the  lower  8-bits  of  the  address.  This  feature 
allows  interrupt  routines  to  be  dynamically  located  anywhere  in  memory 
with  absolute  minimal  access  time  to  the  routine. 

v)  Memory  Refresh  Register  (R) :  The  Z-80  CPU  contains  a  memory  refresh 
counter  to  enable  dynamic  memories  to  be  used  with  the  same  ease  as 
static  memories.  This  7-bit  register  is  automatically  incremented  after 
each  instruction  fetch.  The  data  in  the  refresh  counter  is  set  out  on 
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the  lower  portion  of  the  address  bus  along  with  a  refresh  control  signal 
while  the  CPU  is  decoding  and  executing  the  fetched  instruction.  This 
mode  of  refresh  is  totally  transparent  to  the  programmer  and  does  not 
slow  down  the  CPU  operation.  The  programmer  can  load  the  R  register  for 
testing  purposes,  but  this  register  is  normally  not  used  by  the 
programmer. 

A. 2. 2.  Accumulator  and  flag  registers 

The  CPU  includes  two  independent  8-bit  accumulators  and  associated 
8-bit  flag  registers.  The  accumulator  holds  the  results  of  8-bit  arithmetic 
or  logical  operations  while  the  flag  register  indicates  specific  conditions  for 
8-  or  16-bit  operations.  The  programmer  selects  the  accumulator  and  flag  pair 
that  he  wishes  to  work  with  with  a  single  exchange  instruction  so  that  he  may 
easily  work  with  either  pair. 

A. 2. 3.  General  purpose  registers 

There  are  two  matched  sets  of  general  purpose  registers,  each  set 
containing  six  8-bit  registers  that  may  be  used  individually  as  8-bit  registers 
or  16-bit  register  pairs  by  the  programmer.  One  set  is  called  BC,  DE,  and  HL 
while  the  complementary  set  is  called  BD',  DE',  and  HL'.  At  any  one  time 
the  programmer  can  select  either  set  of  registers  to  work  with  through  a 
single  exchange  command  for  the  entire  set.  In  systems  where  fast  interrupt 
response  is  required,  one  set  of  general  purpose  registers  and  an  accumulator/ 
flag  register  may  be  reserved  for  handling  this  very  fast  routine.  Only  a 
simple  exchange  command  need  be  executed  to  go  between  the  routines.  This 
greatly  reduces  interrupt  service  time  by  eliminating  the  requirement  for 
saving  and  retrieving  register  contents  in  the  external  stack  during  interrupt 
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or  subroutine  processing.  These  general  purpose  registers  are  used  for  a  wide 
range  of  applications  by  the  programmer.  They  also  simplify  programming, 
especially  in  ROM  based  systems  where  little  external  read/write  memory  is 
available. 


A. 3.  Arithmetic  and  Logic  Unit  (ALU) 

The  8-bit  arithmetic  and  logical  instructions  of  the  CPU  are 
executed  in  the  ALU.  Internally  the  ALU  communicates  with  the  registers  and 
the  external  data  bus  on  the  internal  data  bus.  The  type  of  functions 
performed  by  the  ALU  include 


Add 

Subtract 
Logical  AND 
Logical  OR 
Logical  EX-OR 
Compare 


Left  or  right  shifts  (arithmetic  and  logical) 

Increment 

Decrement 

Set  bit 

Reset  bit 

Test  bit 


A. 4.  Instruction  Registers  and  CPU  Control 

As  each  instruction  is  fetched  from  memory,  it  is  placed  in  the 
instruction  register  and  decoded.  The  control  section  performs  this  function 
and  then  generates  and  supplies  all  of  the  control  signals  necessary  to  read 
or  write  data  from  or  to  the  registers,  controls  the  ALU  and  provides  all 
required  external  control  signals. 
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A.  5.  Z-80  CPU  Pin  Description 

The  Z-80  CPUis  packaged  in  a  standard  40-pin  dual  in-line  package. 
The  I/O  pins  are  shown  in  Figure  A. 3  and  the  function  of  each  is  described 
below . 


(Address  Bus) 


D0-D 


7 


(Data  Bus) 


*1 

(Machine  Cycle  One) 


Tri-state  output,  active  high.  A^-A^  constitute 
a  16-bit  address  bus.  The  address  bus  provides  the 
address  for  memory  (up  to  64K  bytes)  data  exchanges 
and  for  I/O  device  data  exchanges.  I/O  addressing 
uses  the  8  lower  address  bits  to  allow  the  user  to 
directly  select  up  to  256  input  or  output  parts. 

During  refresh  time,  the  lower  7-bits  contain  a  valid 
refresh  address. 

Tri-state  input/output,  active  high.  DQ~Dy  consti¬ 
tute  an  8-bit  bidirectional  data  bus.  The  data  bus  is 
used  for  data  exchanges  with  memory  and  I/O  devices. 
Output,  active  low.  M^  indicates  that  the  current 
machine  cycle  is  the  OP  code  fetch  cycle  of  an  instruc¬ 
tion  execution.  Note  that  during  execution  of  2-byte 
OP-codes,  M^  is  generated  as  each  OP  code  byte  is 
fetched.  These  two  byte  OP-codes  always  begin  with 
CBH,  DDH,  EDH,  or  FDH.  also  occurs  with  IORQ  to 
indicate  an  interrupt  acknowledge  cycle. 

Tri-state  output,  active  low.  The  memory  request 
signal  indicates  that  the  address  bus  holds  a  valid 
address  for  a  memory  read  or  memory  write  operation. 


MREQ 

(Memory  Request) 
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IORQ 

(Input/Output 


RD 

(Memory  Read) 


WR 

(Memory  Write) 


RFSH 

(Refresh) 


HALT 

(Halt  State) 


Tri-state  output,  active  low.  The  IORQ  signal  indicates 
Request)  Che  iower  half  of  the  address  bus  holds  a  valid 

I/O  address  for  a  I/O  read  or  write  operation.  An 
IORQ  signal  is  also  generated  with  an  M^  signal  when  an 
interrupt  is  being  acknowledged  to  indicate  that  an 
interrupt  response  vector  can  be  placed  on  the  data  bus. 
Tri-state  output,  active  low.  RD  indicates  that  the 
CPU  wants  to  read  data  from  memory  or  an  I/O  device. 

The  addressed  I/O  device  or  memory  should  use  this 
signal  to  gate  data  into  the  CPU  data  bus. 

Tri-state  output,  active  low.  WR  indicates  that  the 
CPU  data  bus  holds  valid  data  to  be  stored  in  the 
addressed  memory  or  I/O  device. 

Output,  active  low.  RFSH  indicates  that  the  lower  7 
bits  of  the  address  bus  contain  a  refresh  address  for 
dynamic  memories  and  current  MREQ  signal  should  be  used 
to  do  a  refresh  read  to  all  dynamic  memories.  A^  is  a 
logic  zero  and  the  upper  8  bits  of  the  address  bus 
contains  the  I  register. 

Output,  active  low.  HALT  indicates  that  the  CPU  has 
executed  a  HALT  instruction  and  is  awaiting  an  inter¬ 
rupt  before  operation  can  resume.  While  halted,  the 
CPU  executes  NOP's  to  maintain  memory  refresh  activity. 
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WAIT 

(Wait) 


INT 

(Interrupt  Request) 


NMI 

(Nonmaskable 

Interrupt) 


RESET 

(Reset) 


Input,  active  low.  WAIT  indicates  to  the  CPU  that  the 
addressed  memory  or  I/O  devices  are  not  ready  for  a 
data  transfer.  The  CPU  continues  to  enter  wait  states 
for  as  long  as  this  signal  is  active.  This  signal 
allows  memory  or  I/O  devices  of  any  speed  to  be 
synchronized  to  the  CPU. 

Input,  active  low.  The  interrupt  request  signal  is 
generated  by  I/O  devices.  A  request  will  be  honored 
at  the  end  of  the  current  instruction  if  the  internal 
software  controlled  interrupt  enable  flip-flop  is 
enabled  and  if  the  BUSRQ  signal  is  not  active.  When 
the  CPU  accepts  an  interrupt,  an  acknowledge  signal  is 
sent  out  at  the  beginning  of  the  next  instruction  cycle. 
Input,  negative  edge  triggered.  The  NMI  request  line 
has  a  higher  priority  than  INT  and  is  always  recognized 
at  the  end  of  the  current  instruction,  independent  of 
the  status  of  the  interrupt  enable  flip-flop.  NMI 
automatically  forces  the  CPU  to  restart  to  location 
0066H.  The  PC  is  automatically  saved  in  the  external 
s .ack  so  that  the  user  can  return  to  the  program  that 
was  interrupted. 

Input,  active  low.  RESET  forces  the  PC  to  zero  and 
initializes  the  CPU.  This  includes 

1)  Disable  the  interrupt  enable  flip-flop 

2)  Set  register  I  ■  00H 
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BUSRQ 

(Bus  Request) 


BUSAK 

(Bus  Acknowledge) 


$ 


3)  Set  register  R»OOH 

4)  Set  interrupt  mode  0 

During  reset  time,  the  address  bus  and  the  data  bus 
go  to  a  high  impedance  state  and  all  control  output 
signals  go  to  the  inactive  state.  No  refresh  occurs. 
Input,  active  low.  The  bus  request  signal  is  used  to 
request  the  CPU  address  bus,  data  bus,  and  tri-state 
output  control  signals  to  go  to  a  high  impedance  state 
so  that  other  devices  can  control  these  buses.  When 
BUSRQ  is  activated  the  CPU  will  set  these  buses  to  a 
high  impedance  state  as  soon  as  the  current  CPU  machine 
cycle  is  terminated. 

Output,  active  low.  Bus  acknowledge  is  used  to 
indicate  to  the  requesting  device  that  the  CPU  address 
bus,  data  bus,  and  tri-state  control  bus  signals  have 
been  set  to  their  high  impedance  state  and  the  external 
device  can  now  control  these  signals. 

Single  phase  system  clock. 


A.  6.  CPU  Timing 

The  Z-80  CPU  executes  instructions  by  stepping  through  a  very  precise 
set  of  a  few  basic  operations.  These  include 
Memory  read  or  write 
I/O  device  read  or  write 


Interrupt  acknowledge. 
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All  instructions  are  merely  a  series  of  these  basic  operations.  Each  of 
these  basic  operations  can  take  from  three  to  six  clock  periods  to  complete  or 
they  can  be  lengthened  to  synchronize  the  CPU  to  the  speed  of  external  devices. 
The  basic  clock  periods  are  referred  to  as  T  states  and  the  basic  operations 
are  referred  to  as  M  cycles.  Figure  A. 4  illustrates  how  a  typical  instruction 
will  be  merely  a  series  of  specific  M  and  T  cycles.  The  first  machine  cycle 
of  any  instruction  is  a  fetch  cycle  which  is  four,  five,  or  six  T  stages  long 
(unless  lengthened  by  the  wait  signal) .  The  fetch  cycle  (Ml)  is  used  to  fetch 
the  OP  code  of  the  next  instruction  to  be  executed.  Subsequent  machine  cycles 
move  data  between  the  CPU  and  memory  or  I/O  devices  and  they  may  have  anywhere 
from  three  to  five  T  cycles  (again  they  may  be  lengthened  by  wait  states  to 
synchronize  the  external  devices  to  the  CPU) . 


A. 7.  Z-80  CPU  Instruction  Set 

The  Z-80  CPU  can  execute  158  different  instruction  types  including 
all  78  of  the  8080A  CPU.  The  instructions  can  be  broken  down  into  the  following 
major  groups 

Load  and  exchange 
Block  transfer  and  search 
Arithmetic  and  logical 
Rotate  and  shift 

Bit  manipulation  (set,  reset,  test) 

Jump,  call,  and  return 
Input/output 


Basic  CPU  control. 


78 


T-Stqrt 


awJ 


Mi 

M2 

M3 

(OP  Code  Fetch) 

(Memory  Read) 

Instruction  Cycle 

(Memory  Write ) 

W-IMl 


Figure  A. 4. 


Basic  CPU  timing  example. 
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A.7.1»  Introduction  to  instruction  types 

The  load  instructions  move  data  internally  between  CPU  registers  or 
between  CPU  registers  and  external  memory.  The  source  location  is  not  altered 
by  a  load  instruction.  This  group  also  includes  load  immediate  to  any  CPU 
register  or  to  any  external  memory  location.  The  exchange  instructions  can 
trade  the  contents  of  two  registers. 

A  unique  set  of  block  transfer  instructions  is  provided  in  the  Z-80. 
With  a  single  instruction  a  block  of  memory  of  any  size  can  be  moved  to  any 
other  location  in  memory.  With  a  single  Z-80  block  search  instruction,  a  block 
of  external  memory  of  any  desired  length  can  be  searched  for  any  8-bit 
character.  Once  the  character  is  found  the  instruction  automatically  terminates. 
Both  the  block  transfer  and  the  block  search  instructions  can  be  interrupted 
during  their  execution  so  as  to  not  occupy  the  CPU  for  long  periods  of  time. 

The  arithmetic  and  logical  instructions  operate  on  data  stored  in 
the  accumulator  and  other  general  purpose  CPU  registers  or  external  memory 
locations.  The  results  of  the  operations  are  placed  in  the  accumulator  and 
the  appropriate  flags  are  set  according  to  the  result  of  the  operation.  This 
group  also  includes  16-bit  addition  and  subtraction  between  16-bit  CPU 
registers . 

The  bit  manipulation  instructions  allow  any  bit  in  the  accumulator, 
any  general  purpose  register  or  any  external  memory  location  to  be  set,  reset, 
or  tested  with  a  single  instruction.  This  group  is  especially  useful  in 
control  applications  and  for  controlling  software  flags  in  general  purpose 
programming. 

The  jump,  call,  and  return  instructions  are  used  to  transfer  control 
between  various  locations  in  the  user's  program.  This  group  uses  several 


different  techniques  for  obtaining  the  new  PC  address  from  specific  external 
memory  locations.  A  unique  type  of  jump  is  the  restart  instruction.  Program 
jumps  may  also  be  achieved  by  loading  register  HL,  IX,  or  IY  directly  into  the 
PC,  thus  allowing  the  jump  address  to  be  a  complex  function  of  the  routine 
being  executed. 

The  input/output  group  of  instructions  in  the  Z-80  allows  for  a  wide 
range  of  transfers  between  external  memory  locations  or  the  general  purpose 
CPU  registers,  and  the  external  I/O  devices.  In  each  case,  the  port  number  is 
provided  on  the  lower  8  bits  of  the  address  bus  during  any  I/O  transaction. 

One  instruction  allows  this  port  number  to  be  specified  by  the  second  byte  of 
the  instruction  while  other  Z-80  instructions  allow  it  to  be  specified  as  the 
content  of  the  C  register.  One  major  advantage  of  using  the  C  register  as  a 
pointer  to  the  I/O  device  is  that  it  allows  difficult  I/O  ports  to  share 
common  software  driver  routines.  This  is  not  possible  when  the  address  is 
part  of  the  OP  code  if  the  routines  are  stored  in  ROM.  Another  feature  of 
these  input  instructions  is  that  they  set  the  flag  register  automatically  so 
that  additional  operations  are  not  required  to  determine  the  state  of  the  data. 
The  CPU  includes  single  instructions  that  can  move  blocks  of  data  (up  to  256 
bytes)  automatically  to  or  from  any  I/O  port  directly  to  any  memory  location. 

In  conjunction  with  the  dual  set  of  general  purpose  registers,  these 
instructions  provide  for  fast  I/O  block  transfer  rates.  The  value  of  this  I/O 
instruction  set  is  demonstrated  by  the  fact  that  the  CPU  can  provide  all 
required  floppy  disk  formatting  on  double  density  floppy  disk  drives  on  an 
interrupt  driven  basis. 

Finally,  the  basic  CPU  control  instructions  allow  various  options  and 
modes.  This  group  includes  instructions  such  as  setting  or  resetting  the  inter¬ 
rupt  enable  flip  flop  or  setting  the  mode  of  interrupt  response. 


APPENDIX  B 


In  this  appendix,  the  software  in  Z-80  assembly  language  for  imple¬ 
menting  the  Pi-controller  is  given.  The  first  part  of  the  program  computes 
the  control  signals  at  each  sampling  instant.  The  second  part  of  the  program 
consists  of  the  various  subroutines  which  were  used  to  perform  all  the 
floating  point  computations  (addition,  multiplication,  vector  multiplication, 
and  conversion  from  floating  point  to  fixed  point) .  The  program  has  been 
properly  documented  with  appropriate  comments  to  facilitate  easier  understanding 
of  the  algorithms  involved. 
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1399 

CD  C313 

139C 

22  2915 

1S9F 

DB1A 

1351 

97 

1332 

OEOO 

1359 

2A  3215 

1357 

CD  C.313 

133  A 

22  2613 

153D 

DB1B 

155F 

97 

15  AO 

OEOO 

1362 

2A  3915 

1563 

CD  C513 

1368 

22  2813 

156B 

21  0015 

156E 

CD  CC15 

1S/J 

2A  3613 

1579 

CD  PE 15 

1377 

D319 

1379 

21  0C15 

137C 

CD  CC13 

157F 

2A  3815 

13B2 

CD  DE13 

1583 

D31A 

1387 

21  1815 

1S8A 

CD  CC13 

1580  2A  3A13 
1590  CD  DE13 
1393  D31B 
1593  2A  2«13 


1598 

EB 

1599 

2A 

2A15 

159C 

99 

139P 

9D 

139E 

CD 

E713 

15A1 

22 

2A15 

15A9 

2A 

2613 

15A7 

EB 

15A8 

2A 

2C15 

1SAB 

99 

1SAC 

9I< 

13AD 

CD 

E713 

1580 

22 

2C13 

1SB3 

2A 

2813 

15B6 

EB 

13B7 

2A 

2E1S 

13BA 

99 

ISBB 

9D 

1SBC 

CD 

E713 

15BF 

22 

2E15 

13C2 

C3 

9115 

CALL  ERR0K 
LI.'  <X2).HL 
IN  A.!1AH> 

LD  B.A 
t.D  C.O 
LD  HI..  <X3S> 
CALL  ERROR 
LD  (X3>  .HI. 

IN  A.(IBH) 

LD  B.A 
LD  C.O 
LD  HI..CX5S) 
CALL  ERROR 
LD  <>:»>> HI. 
LD  HI. KM 
CALL  CC1HPU 
LU  HI.  . (UIS) 
CALL  C.TRUUT 
OUT  < 1VH>  »A 
LD  HL.K21 
CALL  CUHPU 
LD  Hl.»  (U2S) 
CALL  CTROUT 
OUT  UAH).  A 
LD  HL.K31 
CALL  CUHPU 
LD  HL.<U3S) 
CALL  CTROUT 
OUT  (1DH).A 
l.D  HL>  (X2> 
EX  UL.HL 
LD  HI.»<X6> 
LD  B.H 
LD  C.L 
CALL  ACCOM 
LD  <X6)»HI. 
LD  HL.CX3) 
EX  DK . HI. 

LD  HL.CX7) 
LD  B.H 
l.D  C.L 
CALL  ACCOM 
LD  <X7>.HI. 
LD  HL.CX3) 
E  X  DE.HL 
LD  HI. .  (XB) 
LD  B.H 
LD  C.L 
CALL  ACCOM 
LD  (  X8  >  .  HI. 
JP  LOOP 


) STORE  ERROR 

UNPUT  CURRENT  PITCH 

(CONVERT  TCI  FLOATING  POINT 

(COMPUTE  ERROR! X3-X3S) 

(STORE  ERROR 

(INPUT  CURRENT  ALTITUDE 

(CONVERT  TO  FLOATING  POINT 

I COMPUTE  ERROR (X3-XSS) 

I  STORE  ERROR 

(COMPUTE  FEEDBACK  CONTROL  01 

I  COMPUTE  OVERALL  CONTROL  U1 
1-IN  FIXED  POINT 
(OUTPUT  U1 

(COMPUTE  FEEDBACK  CONTROL  U2 

(COMPUTE  OVERALL  CONTROL  U2- 
( -IN  FIXED  POINT 
(OUTPUT  U2 

(COMPUTE  FEEDBACK  CONTROL  03 

(COMPUTE  OVERALL  CONTROL  U3- 
(-IN  FIXED  POINT 
(OUTPUT  U3 

(UPDATE  INTEGRATOR  FOR  X2- 
(X6»X6+<X2-X2S) 


(UPDATE  INTEGRATOR  FOR  X3 
(X7«X7+!X3-X3S> 


(UPDATE  INTEGRATOR  FOR  X5 
(X8"XB+!Xb-X5S> 
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2-80  A»s*»bler  VI  •  1 


i SUBROUTINE  CALCULATES  STATE  ERROR 


13C3 

EB 

ERROR  F:>:  Ul’fHL 

13C4 

CD  ED15 

CALL  FADD 

15C9 

60 

LD  H?B 

1SCA 

69 

LD  l.rC 

15CB 

C 9 

RET 

i SUBROUTINE  CDHPUTI 

1SCC 

22  1523 

COHPU  LD  ( AMI )  » HI¬ 

13CF 

21  2415 

LO  HI.  ?X2 

1SD2 

22  1723 

LD  ( AD2) »  HL 

1SDS 

3E06 

I  D  A » 06H 

13D7 

32  1423 

LD  ( D1H ) »  A 

15DA 

CD  FC16 

CALL  VCMLT 

HDD 

r,? 

RET 

1  SUBROUT  INF  CALCUf 
i IN  FIXED  POINT 

13DE 

EB 

ctrout  f:>:  i»e *hl 

15DF 

CD  ED15 

CALL  FADD 

13E2 

CD  3317 

CALL  CNRT 

13ES 

78 

ID  A » B 

13E4 

C9 

RET 

» SUBROUTINE  UPDATE 

13E7 

CD  EDI 5 

ACCUM  CALL  FADD 

isea 

60 

LD  H»B 

13EB 

69 

LD  l.tC 

1SEC 

C9 

RET 

i SUBROUTINE  PERF0R 
i  ( BC  )  ♦  <  DE )  <  BO ) 

15E0 

78 

FADD  LD  A »  B 

13EK 

A7 

AND  A 

13EF 

CA  5B16 

JP  Z»KSLTD 

13F2 

7A 

LD  A »  D 

13F3 

A7 

AND  A 

1SF4 

C8 

RET  Z 

13F3 

79 

LD  A»C 

15F4 

93 

SUB  E 

15F7 

67 

LD  H»  A 

1SFB 

CA  2816 

JP  Z»AD 

13FB 

F2  1816 

JP  PfSFTS 

13FE 

3E00 

SFTB  LD  A » OOH 

1400 

94 

SUB  H 

1 60 1 

67 

LD  H»A 

1402 

48 

LD  C»E 

1403 

Ft  08 

CP  08H 

1403 

F2  5B16 

JP  PfRSLTD 

140P 

78 

SFTI.P  I  D  A* B 

140? 

E6FE 

AND  OF  E  H 

140B 

F2  OF 16 

JP  PfSFTRP 

140E 

3F 

CL'F 

160F 

IF 

SFTRP  RRA 

1410 

47 

LD  B* A 

I 


I 

I 

Z-80  Aimbltr  VI  .  1 


1611 

25 

DEC  H 

1612 

C2  0816 

JP  NZ.SFTl.P 

1615 

C3  2816 

JP  AD 

1618 

FF08 

SFTS 

CP  OBH 

1616 

F0 

rf;t  p 

(618 

76 

SFTL 

LD  A.D 

161C 

E6FE 

AND  OFFH 

161E 

F2  2216 

JP  P.SFTR 

1621 

3F 

CCF 

1622 

IF 

SFTR 

KRA 

1623 

57 

I  D  Of  A 

1624 

25 

DEC  H 

1625 

C2  1816 

JP  MZ.SFTl. 

1628 

78 

60 

LO  A.B 

1629 

66 

XOR  D 

1626 

FA  4316 

JP  M.ADZ 

162D 

78 

LD  A.B 

162E 

67 

AND  A 

162F 

FA  3E16 

JP  H.LZRO 

1632 

82 

AMD  A.O 

1633 

F2  SE16 

JP  P.POSS 

1636 

IF 

NRh 

KRA 

1637 

02  3016 

JP  NC.HNCK 

1636 

3C 

INC  A 

1630 

Of; 

NNCR 

INC  C 

16.C 

47 

DON 

LD  B.A 

1630 

C9 

RET 

163E 

82 

LZRO 

ADD  A.D 

163F 

FA  6716 

JP  N.NEG6 

1642 

C3  3616 

JP  NRh 

1645 

78 

6117 

LD  A.B 

1646 

82 

ADD  A.D 

1647 

CA  5616 

JP  Z.ZER 

1646 

FA  6716 

JP  K.NEGG 

1640 

00 

LI 

DEC  C 

164E 

87 

ADD  A. A 

1A4F 

F2  4016 

JP  P.LL 

1652 

IF 

RRA 

1653 

OC 

INC  C 

1654 

47 

LD  8. A 

1655 

C? 

RET 

1656 

0600 

ZEK 

LD  B.OOH 

1658 

0E00 

LD  C.OOH 

1656 

C9 

RET 

16SB 

42 

RSLTn  LD  B»D 

165C 

40 

LD  C.E 

1650 

C? 

RET 

165E 

00 

POSS 

DEC  C 

163F 

87 

AMD  A. A 

1660 

F2  5E16 

JP  P.POSS 

1663 

IF 

RRA 

86 
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1664 

OC 

INC  C 

1663 

47 

LD  B  9  A 

1666 

C9 

RET 

1667 

00 

NEGG 

DEC:  C 

1668 

87 

ADD  AiA 

1669 

F8 

6716 

JP  H»NEGG 

166C 

IF 

RRA 

166D 

OC 

INC  C 

166E 

47 

LD  H» A 

166F 

C9 

RET 

•  SUBROUTINES  PERFORMS  FLOATING  POINT  HUL  TIPI  IC8TI0N 

» <8C)*(DE)»<8C> 

1670 

79 

FMULT 

LD  A»C 

1671 

83 

ADD  A'E 

1672 

6F 

LD  L » A 

1673 

78 

LD  A»B 

1674 

88 

XOR  D 

1673 

F  8 

8016 

JP  M  9  NG 

1678 

78 

LD  AbB 

1679 

87 

AND  A 

167A 

F2 

8416 

JP  PfBPOS 

1670 

2F 

CPL 

167E 

3C 

INC  A 

167F 

47 

LD  B  9  A 

1680 

78 

LD  A » D 

1681 

2F 

CPL 

1682 

3C 

INC  A 

1683 

37 

LD  D9A 

1684 

48 

BPOS 

LD  C»B 

1683 

CO 

0316 

CALL  Ml.T 

1688 

78 

1.0 

LD  AtB 

1689 

87 

AND  A 

1688 

F8 

9716 

JP  M  9  L 101 

168D 

79 

LD  A fC. 

168C 

87 

ADD  A9A 

168F 

4F 

LD  C9A 

1690 

78 

LD  A 9  B 

1691 

17 

RI.A 

1692 

47 

LD  B9A 

1693 

20 

DEC  L 

1694 

f.3 

8816 

JP  LO 

1697 

IF 

L101 

RRA 

1698 

47 

LD  B9A 

1699 

02 

9016 

JP  NC  9  NAD 

169C 

04 

INC  B 

1690 

2C 

NAD 

INC  L 

169E 

40 

LD  C9L 

169F 

C9 

RET 

1680 

78 

NG 

LD 

1681 

A7 

AND  A 

1682 

F2 

8816 

JP  P  9  DNEG 

87 
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1AA5 

2F 

1AAA 

3C: 

1AA7 

47 

1AA8 

C3  APIA 

1AAR 

7A 

DNEG 

\  6  AC 

2F 

JAAP 

3C 

1AAE 

57 

tAAF 

48 

L202 

16B0 

CD  D316 

1AB3 

78 

L3 

1AB4 

A7 

1AB3 

FA  C21A 

1AB8 

79 

i  AB9 

87 

1  ABA 

4F 

1  ABB 

78 

1  ABC 

!  “» 

1ABT 

^  •' 

1  AD 

16bt 

13  B31 A 

1AC2 

IF 

L4 

t  AC3 

47 

t  AC-4 

D2  C81 A 

JAC7 

04 

1  ACS 

?C 

NNAD 

1AC9 

4D 

1ACA 

78 

1ACB 

2F 

1  ACC 

3C 

1ACD 

47 

1  ACE 

C9 

1 ACF 

OAOO 

ZfcU 

1AD1 

OEOO 

1 AD3 

El 

1 AD4 

C9 

1  ADS 

79 

NLT 

1  ADA 

A  7 

1  AD7 

CA  CF 16 

1  ADA 

4F 

t  APR 

7A 

t  ADC 

A7 

1ADD 

CA  CF1A 

1AEO 

OAOO 

1AE2 

1E09 

X  AE4 

79 

NULTO 

tAES 

IF 

IAEA 

4  F 

JAE7 

ID 

1 AF  8 

CA  F51 A 

1AEB 

78 

CPL 
INC  A 
LD  B » A 

jp  l;,'02 

I  D  A»D 
CPU 
INC  A 
LD  D» A 
LD  C»R 
CALL  Hl.l 
LD  A » B 
AND  A 
JP  M»L4 
IH  A  *  C 
ADD  A » A 
LD  C » A 
LD  A»B 
RLA 

l.H  B* A 
DEC  L 
JP  L3 
RKA 

LD  B* A 
JP  NC  * NNAD 
INC  B 
INC  L 
LD  C »L 
LD  A»B 
CPI 
INC  A 
LD  B  *  A 
RF.T 

ID  B»OOH 
LD  C.OOM 
POP  HI¬ 
RE  T 
LD  AtC 
AND  A 
JP  Z  *  ZRli 
LD  C » A 
LD  A  *  D 
AND  A 
JP  Z»ZRO 
ID  B*OOH 
LD  E  »09H 
L»  ArC 
RRA 

LD  C  *  A 
DEC  E 
JP  Z  t DONE 
ID  A » B 
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16EC 

D2 

F016 

JP  NCr MULTI 

16EF 

82 

AMD  At  D 

16F0 

IF 

MULTI 

RRA 

16F  1 

47 

LD  B  ♦  A 

16F2 

C3 

£416 

JP  Mill.  TO 

16F5 

79 

DONE 

ID  A  ♦  C 

1 6F6 

87 

AMD  A  »  A 

16F7 

4F 

l.D  C»A 

16F8 

78 

LD  AfB 

16F9 

1  7 

RLA 

16FA 

47 

LD  &♦  A 

16FP 

C9 

RKT 

♦  SUBROUTINE  PFKKlRMS  ElOATING  POINT  VICTOR  MULTI  PI  ICATION 

♦  BI IMENSION  OF  VECTORS  :  DIM 

♦  POINTER  1  Ci  FIRST  VECTOR  :  ADI 

> POINTER  TO  SECOND  VECTOR  J  AIVJ 
) TEMPORARY  STORAGE  J  TEMP 

♦  COUNTER  *.  CNT 
♦RESULT  J  BC-PAIR 


16FC 

3A  1423 

VCNLT  LD  A* (DIM) 

16FF 

32  1F23 

LD  (CNT)tA 

\  702 

01  0000 

ID  BCtOOOOH 

1705 

ED43  11*23 

I  D  <  TEMP )  *  BC 

1709 

2A  1323 

L10  l.D  HI.  ♦  <  AMI  ) 

170  C 

4E 

LD  C »  <  HI. ) 

I70D 

23 

INC  HI. 

170E 

46 

LD  B  ♦  (  HI. ) 

17  OF 

23 

INC  HI. 

1710 

22  1323 

LD  (AMl)fKt. 

1713 

2A  1723 

I  D  HI.  ♦  (  AH2  > 

1716 

3E 

LD  E  ♦  <  HI. ) 

171? 

23 

INC  HI 

1718 

56 

l.D  D*  <  HI. ) 

1719 

23 

INC  HI. 

171 A 

22  1723 

LD  <  AM2 )  •  HI. 

1  /ID 

(.0  7016 

CALL  FMULT 

1770 

ED3E*  1 1*23 

LD  DP ♦ ( 1 FMF > 

1724 

CD  ED  13 

CALL  F AMD 

1/27 

ED43  1D23 

LD  (  TEMP  )  ♦  BC 

1  ??B 

21  1F23 

l.M  HI.  ♦  CNT 

17  7F 

33 

DEC  (HI.) 

1 72F 

C2  0917 

JP  NZfLlO 

1732 

ce 

RET  Z 

1  SUBROUTINE  PERFORMS  FLOAT 
iflXFJi  POINT  CONVERSION 

M  BC  >*( B  > 

1733 

79 

CNRT  l.D  A*C 

1734 

FEF8 

CP  0F8H 

1736 

F?  3C1 7 

JP  PfNVZ 

1739 

0600 

LD  BfOOH 

1 73* 

C9 

RET 

'Ju 
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173c 

A7 

NTZ 

AND  A 

1730 

ca 

RF.T  2 

173E 

FE01 

CP  01H 

1740 

F2  3117 

JP  P.SAT 

1743 

78 

l.Ii  A»8 

1744 

E6FE 

LPP 

AND  OFEH 

1744 

F2  4A17 

JP  P.STRP 

1749 

3F 

TCF 

1 74A 

IF 

STRP 

KRA 

174B 

OC 

INC  C: 

174C 

C2  4417 

JP  N7.LPP 

174F 

47 

LD  B.A 

1730 

C9 

RF.T 

1731 

78 

SAT 

LD  A. 8 

1732 

A7 

AND  A 

1753 

067F 

LD  B.7FM 

1733 

FO 

RET  P 

1736 

04 

INC  B 

1757 

C? 

rf:t 

END 
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